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Abstract 

Local  collision  avoidance  is  an  important  problem  that  must  be  solved  for  safe  autonomous 
flight  of  Unmanned  Aerial  Vehicles  (UAVs).  In  order  to  successfully  find  a  solution  to 
this  problem,  an  elaborate  literature  survey  has  been  conducted.  This  survey  of  literature 
led  to  a  fairly  thorough  understanding  of  the  state-of-art  techniques  in  the  areas  of  path 
planning  and  collision  avoidance  of  UAVs.  Next,  taking  the  help  of  the  recently  proposed 
philosophies  of  ‘collision  cone  approach’  and  ‘dynamic  inversion’,  a  nonlinear  differential 
geometric  guidance  law  has  been  developed  and  successfully  tested  from  simulation  studies. 
Consequently,  a  recently-developed  missile  guidance  law,  named  as  ‘aiming  point  guidance 
(APG)’  has  been  tested  successfully  for  the  same  purpose  as  well.  Next,  this  linear  APG 
law  has  been  modified  to  propose  a  nonlinear  APG  law.  Moreover,  correlations  have  been 
obtained  between  the  gains  in  the  differential  geometric  based  guidance  laws  and  geometric 
guidance  laws  that  makes  them  perform  in  a  similar  manner.  Note  that  whereas  nonlinear 
APG  law  can  perform  ‘exactly  same’  as  the  dynamic  inversion  based  guidance  law  (provided 
gains  are  selected  in  such  a  way  that  they  satisfy  the  correlation  among  them),  the  linear 
APG  can  at  best  be  close  to  it  (because  of  the  linearization  approximation).  The  proposed 
guidance  laws  have  been  validated  from  3-D  simulation  studies.  Finally,  they  have  been 
further  validated  by  incorporating  a  first-order  autopilot  in  the  loop  as  well.  This  study 
shows  that  the  proposed  guidance  schemes  can  give  satisfactory  results  with  autopilot  delays 
upto  0.2  Sec. 


Chapter  1 
Introduction 


Unmanned  aerial  vehicles  (UAVs)  are  expected  to  be  ubiquitous  in  the  near  future,  au¬ 
tonomously  performing  complex  military  and  civilian  missions  such  as  reconnaissance,  en¬ 
vironmental  monitoring,  border  patrol,  search  and  rescue  operations,  disaster  relief,  traffic 
monitoring  etc  [DeGarmo  &  Nelson(2004)].  Many  of  these  applications  require  the  UAV  to 
fly  at  low  altitudes  in  proximity  with  man  made  and  natural  structures.  A  collision  with 
a  stationary  structure  or  another  UAV  could  prove  to  be  potentially  fatal,  and  might  even 
result  in  mission  failure.  Therefore,  it  is  required  that  the  UAV  must  be  able  to  successfully 
sense  and  avoid  obstacles  and  at  the  same  time  look  ahead  to  pursue  its  goal.  This  requires 
robust  and  computationally  feasible  collision  avoidance  algorithms  to  be  implemented  on¬ 
board  the  UAV. 

UAVs  however  have  limited  resources.  Several  implications  exist  for  any  algorithm  to  be 
implemented  onboard: 

1.  Size  of  the  onboard  processor  is  limited.  The  processing  speed  and  memory  available  to 
the  algorithm  arc  limited.  Therefore,  the  algorithm  must  be  computationally  efficient. 

2.  The  algorithm  must  respond  quickly,  so  that  it  can  be  implemented  in  an  online  navi¬ 
gation  system. 

3.  The  payload  of  UAVs  is  extremely  limited.  Therefore  the  sensor  used  to  gain  infor¬ 
mation  from  the  surroundings  must  be  lightweight.  The  sensors  used  must  also  be 
economical  and  energy  efficient. 
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4.  In  addition,  UAVs  may  need  to  avoid  detection  for  certain  stealthy  missions  like  enemy 
reconnaissance.  Active  sensors,  which  send  out  energy  into  the  environment  are  thus 
not  suitable,  since  they  can  be  detected. 

In  view  of  (3)  and  (4),  vision  based  navigation  is  a  suitable  option,  since  it  is  lightweight, 
economical  as  well  as  covert.  The  collision  avoidance  algorithms  should  therefore  be  able  to 
perform  well  with  vision  data,  which  is  usually  noisy  and  inaccurate.  Collision  avoidance 
algorithms  must  satisfy  the  above  requirements. 

UAV  collision  avoidance  approaches  can  be  classified  into  deliberative  global  path  plan¬ 
ning  and  reactive  local  collision  avoidance  algorithms.  Global  path  planning  algorithms 
assume  complete  knowledge  of  the  environment  beforehand  and  find  an  obstacle-free  tra¬ 
jectory  to  the  goal  point.  These  methods  take  into  account  the  dynamics  of  the  UAV,  and 
avoid  known  obstacles  like  buildings,  trees  etc.  Additionally,  the  UAV  constraints  such  as 
turn  radius  and  kinodynamic  constraints  are  also  taken  into  account.  They  also  attempt 
to  find  optimal  paths.  These  methods  are  usually  computationally  expensive  and  cannot 
be  executed  online.  Additionally,  global  planning  methods  are  unsuitable  for  avoiding  colli¬ 
sions  with  pop-up  and  moving  obstacles.  Local  methods  are  reactive,  i.e.  an  onboard  sensor 
detects  the  possibility  of  collision  and  then  an  alternative  route  is  planned  online.  These 
consist  of  computationally  efficient  algorithms  and  are  able  to  react  quickly  to  changes  in  the 
environment.  However  these  methods  cannot  guarantee  optimality.  Local  navigation  meth¬ 
ods  do  not  retain  global  information  and  continually  react  to  changing  environments.  It  is 
essential  that  local  planning  methods  are  fast,  since  the  speed  of  the  UAV  is  limited  by  them. 

Recent  collision  avoidance  approaches  implement  multi-layer  architectures.  A  global 
planning  layer  first  finds  a  dynamically  feasible  obstacle-free  optimal  path  to  the  goal,  and 
then  a  local  collision  avoidance  layer  reacts  to  changes  in  the  environment  and  computes 
an  alternate,  collision-free  path  online.  This  scheme  reduces  the  computation  resources  re¬ 
quired  since  the  amount  of  online  computation  carried  out  is  less.  Optimality  of  the  path 
may  also  be  guaranteed,  except  for  brief  periods  when  the  UAV  maneuvers  away  from  the 
planned  trajectory  to  avoid  a  local  obstacle.  This  paper  reviews  some  recently  evolving  ideas 
of  collision  avoidance  algorithms.  A  literature  survey  of  recently  evolving  philosophies  on 
obstacle  and  collision  avoidance  of  UAVs  is  presented  in  Chapter  2. 
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Collision  avoidance  is  often  considered  as  another  side  of  the  target  interception  problem 
[Chakravarthy  &  Ghose(1998)].  This  is  because  once  a  potential  collision  is  detected,  an 
alternate  point  may  be  found  which  results  in  avoiding  collision.  After  this,  the  problem 
reduces  to  one  of  finding  a  path  which  satisfies  terminal  conditions.  This  constitutes  a  guid¬ 
ance  problem. 

We  solve  this  problem  by  formulating  a  “Differential  Geometric”  guidance  law  using  a 
nonlinear  control  philosophy  called  Dynamic  Inversion,  used  popularly  in  output  tracking. 
Based  on  this  we  also  formulate  two  geometric  guidance  laws  called  the  Linear  Geometric 
Guidance  and  the  Nonlinear  Geometric  Guidance.  These  guidance  laws  hold  promise  for  not 
only  solving  the  collision  avoidance  problem,  but  the  target  interception  problem  as  well. 
The  collision  avoidance  algorithms  developed  in  the  study  are  sense-and-avoid  algorithms, 
but  with  a  global  element,  since  the  destination  point  is  also  taken  into  account. 
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Chapter  2 

Literature  survey 


This  chapter  presents  a  literature  survey  on  recently  evolving  ideas  for  obstacle  and  collision 
avoidance  for  UAVs.  Although  both  global  path  planning  and  local  collision  avoidance 
methods  are  covered,  the  emphasis  is  on  online  collision  avoidance  in  both. 

2.1  Global  Path  Planning  Algorithms  with  Local  Col¬ 
lision  Avoidance 

Conventionally,  a  basic  motion  planning  problem  consists  of  producing  a  continuous  motion 
that  connects  a  start  configuration  and  a  goal  configuration,  while  avoiding  collision  with 
known  obstacles  [Lavalle(2006)].  The  algorithms  discussed  in  this  section  retain  global  infor¬ 
mation,  i.e.  the  algorithm  first  plans  a  path  to  the  goal  avoiding  the  obstacles  known  apriori. 
If  a  collision  is  predicted  to  occur,  the  path  is  re-planned  so  that  the  obstacle  is  avoided, 
ffowever  the  objective  is  to  always  move  towards  the  goal  point  and  thus  the  re-planned  path 
must  also  reach  the  goal  point  after  collision  is  avoided,  ffence  these  algorithms  are  consid¬ 
ered  to  be  global  path  planning  algorithms  with  local  collision  avoidance  features  imbedded 
into  it. 

2.1.1  Graph  Search  Algorithms 

Graph  search  methods  search  for  a  feasible  path  in  a  given  environment.  Examples  of  graph 
search  algorithms  are  deterministic  graph  search  techniques  such  as  A*  search  algorithm 
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[Ferbach(1998)]  or  Voronoi  graph  search  [Bortoff(2000)]  and  probabilistic  sampling  based 
planners  such  as  Probabilistic  Roadmap  Method  (PRM)  [Pettersson  &  Doherty(2006)].  Al¬ 
though  these  algorithms  are  mainly  used  for  global  path  planning,  reactive  planners  have 
been  achieved  by  modifying  the  algorithms  in  order  to  reduce  the  computation  time.  An 
example  of  search  algorithms  used  for  both  global  and  local  UAV  path  planning  is  the  work 
of  [Hwangbo  et  al.  (2007)].  An  A*  search  algorithm  is  used  for  global  planning,  while  for 
local  obstacle  avoidance,  a  best  first  search  [Lavalle(2006)]  is  performed.  Both  kinematics 
and  dynamics  of  the  UAV  are  taken  into  consideration.  First,  the  global  planner  plans  a 
path  taking  into  account  the  kinematics  of  the  vehicle  (e.g.,  kinematic  constraints  such  as 
minimum  radius  of  curvature  or  maximum  climb  angle).  This  generates  a  set  of  way-points 
for  the  UAV  to  follow.  These  way-points  may  be  tracked  by  a  way-point  controller  (such 
as  a  PD  controller)  in  the  absence  of  obstacles.  When  new  obstacles  are  sensed  the  local 
planner  is  activated,  which  plans  a  path  to  avoid  obstacles  and  go  to  the  sub-goal  (which 
is  in  this  case  the  waypoint  provided  by  the  global  planner).  The  local  planner  takes  into 
account  the  dynamics  of  the  vehicle  (e.g.  constraints  on  velocity  and  acceleration). 

The  global  planner  performs  planning  in  3D  discretized  grids  using  the  A*  search  algo¬ 
rithm.  The  A*  search  algorithm  finds  the  optimal  path  among  the  defined  nodes.  The  UAV 
kinematics  is  taken  into  account  for  defining  the  grid  cell  size  as  well  as  the  node  intercon¬ 
nections,  and  thus  the  optimal  path  found  by  A*  algorithm  is  always  kinematically  feasible. 
At  this  stage  obstacles  smaller  than  the  grid  size  or  moving  obstacles  are  neglected. 

The  local  planner  performs  a  finer  level  of  planning  between  two  way-points  defined  by 
the  global  planner.  Here  the  changes  in  environment  are  updated  continuously,  and  moving 
and  pop-up  obstacles  or  obstacles  smaller  than  the  grid  size  are  taken  into  account  while 
planning  the  path.  Aggressive  maneuvers  beyond  the  kinematics  of  the  vehicle  are  allowed 
at  this  stage  in  order  to  avoid  the  obstacles.  A  sampling  based  motion  planner  under  differ¬ 
ential  constraints  is  used  for  local  planning.  For  this  a  set  motion  primitives  is  used.  Motion 
primitives  are  calculated  at  every  state  by  finding  all  dynamically  feasible  motions  from  that 
state  (Figure  2.1).  These  are  pre-computed  and  saved  in  a  look-up  table  for  efficiency. 

Then,  a  best  first  search  is  done,  in  which  nodes  closer  to  the  sub-goal  are  connected  first. 
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Obstacle  Sub-goal 

Pre-calculated 
motion  primitives 


Figure  2.1:  The  local  planner  finding  the  best  path  among  pre-computed  motion  primitives 

This  saves  computation  time,  as  compared  to  other  search  algorithms  like  A*  or  breadth  first. 
The  cost  function  to  optimize  is  a  heuristic  distance  function,  based  on  2D  Dubins  curves 
[Dubins(1957)].  This  is  because  the  Dubins  path  length  can  be  found  without  expensive  cal¬ 
culations.  This  method  was  shown  to  avoid  local  obstacles  online,  with  average  computation 
times  of  the  order  of  0.15  sec. 

However  the  use  of  pre-computed  motion  primitives  may  not  be  a  suitable  option  in  gen¬ 
eral.  Storing  a  database  of  a  large  number  of  motion  primitives  requires  a  lot  of  memory.  The 
memory  onboard  a  UAV  is  highly  limited.  This  problem  is  especially  valid  for  large,  complex 
environments.  Additionally  the  best-first  search  is  not  systematic  since  it  greedily  explores 
nodes.  The  worst  case  scenario  for  best-first  search  takes  more  memory  than  depth-first 
search  algorithms  [Kumar  &  Korf(1991)].  The  memory  available  on  the  UAV  may  therefore 
not  be  sufficient  to  implement  this  algorithm  onboard. 


2.1.2  Rapidly-exploring  Random  Tree 

Rapidly-exploring  Random  Tree(RRT)  is  a  search  algorithm  that  can  quickly  find  a  feasible 
path  in  high  dimensional,  cluttered  environments  [LaValle(1998)].  The  RRT  is  a  probabilistic 
sampling  based  approach.  A  random  sample  of  the  environment  is  generated  at  each  step, 
and  a  new  node  is  formed  by  growing  the  tree  an  incremental  distance  in  the  direction 
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of  this  node.  A  nice  feature  of  this  algorithm  is  that  it  can  handle  vehicle  dynamics  and 
kinodynamic  constraints.  This  method  is  used  for  motion  planning  in  various  applications 
[LaValle  &  Kuffner(2001)].  The  algorithm  to  grow  an  RRT  and  find  a  feasible  path  is  as 
follows: 

1.  Initiate  the  tree  with  the  initial  point  ximt 

2.  Generate  a  random  point  xrand 

3.  Find  the  node  xnear  in  the  RRT  that  is  nearest  to  xrand ,  using  some  criterion  (e.g. 
distance) 

4.  Grow  a  branch  an  incremental  distance  of  delta  from  xnear  in  the  direction  towards 
xrand •  The  new  point  obtained  is  xnew 

5.  Check  xnew  for  collisions  and  feasibility 

6.  If  collision-free  and  feasible,  add  xnew  to  the  tree 

7.  Repeat  steps  (ii)-(vi)  until  the  goal  point  is  reached 

An  RRT  is  shown  in  Figure  2.2.  This  RRT  avoids  collisions  with  obstacles  and  reaches 
the  goal  point. 


Figure  2.2:  Growing  an  RRT 
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We  conducted  numerical  experiments  in  a  100  m  by  100  m  cluttered  space.  Figure  2.3 
shows  the  path  found  by  the  RRT  with  25  obstacles,  while  2.4  shows  the  path  with  50 
obstacles. 


Figure  2.3:  Path  found  by  RRT  in  a  space  with  25  obstacles. 

As  can  be  seen,  there  are  some  extraneous  branches  in  the  tree  that  are  not  a  part  of  the 
final  path.  This  is  due  to  the  random  nature  of  space  exploration  in  the  method. 

The  RRT  is  used  as  a  global  path  planner  in  [Griffiths  et  al.  (2006)].  With  appropriate 
modifications  [Amin  et  al.  (2006)] ,  RRT  can  be  used  to  plan  a  global,  dynamically  feasible 
and  optimal  path  to  the  goal,  as  well  as  perform  re-planning  when  obstacles  are  detected 
by  the  sensor  onboard.  Since  collision  checking  is  an  expensive  process  in  RRT,  an  effi¬ 
cient  method  of  obstacle  representation  called  Quadtrees  [Frisken  &  Perry(2003)]  is  used. 
Quadtrees  are  a  data  structure  used  to  represent  the  environment  efficiently.  Quadtrees 
divide  the  environment  into  quadrants.  This  division  is  carried  out  until  a  quadrant  is  filled 
by  the  obstacle  and  becomes  a  leaf  node.  It  must  be  noted  that  this  results  in  an  unequal 
spatial  division,  which  is  more  efficient  than  using  uniform  grids. 
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Figure  2.4:  Path  found  by  RRT  in  a  space  with  50  obstacles. 

The  RRT  finds  feasible  paths  to  the  goal  by  avoiding  obstacles.  But  the  path  found 
is  usually  far  from  optimal.  Therefore,  at  the  global  level  of  planning  the  path  found  by 
RRT  is  passed  through  the  Dijkstra’s  algorithm,  which  is  a  search  method  that  finds  short¬ 
est  distance  paths.  The  path  found  by  RRT  is  usually  far  from  optimal  and  needs  to  be 
pruned.  The  Dijkstra’s  search  algorithm  [Lavalle(2006)]  is  used  for  this,  which  first  finds 
the  reachability  of  every  point  and  then  sorts  these  points  according  to  a  cost  function  (an 
approximate  distance  function  in  this  case).  Another  pass  through  this  step  re-samples  the 
points  to  shorter  distances  and  then  finds  the  optimal  path  again.  The  number  of  passes  of 
the  Dijkstra’s  algorithm  depends  on  the  computation  resources  available  and  requirement  of 
optimality. 

To  reduce  computation  time,  a  dual  RRT  concept  is  used,  in  order  to  speed  up  computa¬ 
tion  [Kuffner  &  LaValle(2000)].  Both  trees  are  grown  simultaneously  from  the  start  and  goal 
point  at  each  iteration,  and  at  every  step  a  “connect”  operation  is  performed,  which  tries  to 
connect  both  the  trees.  Perhaps  a  natural  extension  of  this  idea  would  be  to  grow  multiple 
trees  from  fixed  points  in  the  search  space  and  then  perform  multiple  connect  operations  at 
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every  step.  Another  modification  is  made  to  reduce  the  cost  for  finding  the  nearest  point 
in  the  tree  to  add  a  new  node.  An  approximate  distance  function  is  used  for  this,  which 
uses  an  absolute  value  function  and  eliminates  the  necessity  for  square  root  operation.  The 
deviation  from  true  Euclidean  distance  is  claimed  to  be  around  6%,  which  is  not  significant. 

For  3D  implementation,  penalty  for  change  in  altitude  is  made  high.  This  is  because 
change  in  altitude  is  not  a  desired  behavior  for  many  applications  (e.g.  surveillance).  Only 
when  a  path  cannot  be  found  at  the  same  altitude,  a  change  in  altitude  is  allowed.  The 
RRT  is  thus  implemented  both  as  a  global  and  a  local  planner  with  suitable  modifications  as 
discussed.  An  optimal  global  path  is  first  calculated  offline,  and  then  when  the  sensor  detects 
obstacles  the  path  is  modified.  Simulation  results  in  [Amin  et  al.  (2006)]  demonstrate  that 
this  scheme  offers  a  good  global  planner  as  well  as  a  reactive  algorithm  for  online  collision 
avoidance.  An  important  disadvantage  of  RRT  is  that  it  is  an  open  loop  method,  and  thus 
is  sensitive  to  modeling  inaccuracies  and  external  noise  such  as  wind.  Additionally,  avoiding 
collision  with  moving  obstacles  may  not  be  possible,  because  of  the  random  nature  of  the 
algorithm. 

2.1.3  Potential  Field  Method 

The  potential  field  approach  [Khatib(1985)]  has  found  widespread  use  as  a  navigation  method 
for  ground  robots  and  more  recently  in  UAVs.  In  this  method  the  UAV  is  modeled  as  mov¬ 
ing  under  the  influence  of  a  potential  field.  The  artificial  potential  field  function  may  be 
designed  according  to  the  problem,  and  is  determined  by  the  goal  and  the  set  of  obstacles. 
The  idea  is  to  reach  the  goal  point,  along  with  avoiding  collisions  with  any  obstacles  along 
the  way. 

The  potential  function  consists  of  an  “attraction  field” ,  which  pulls  the  UAV  towards  the 
goal,  and  a  “repulsive  field”,  which  ensures  that  the  UAV  does  not  collide  with  obstacles. 
The  resultant  field  defines  the  direction  of  motion.  This  method  is  fast  and  efficient.lt  is  also 
easy  to  add  new  obstacles  to  the  function.  A  formation  of  UAVs  has  also  been  accomplished 
using  the  potential  field  approach[Paul  et  al.(2008)].  The  total  potential  field  experienced 
by  each  UAV  is  a  combination  of  the  potential  field  due  to  the  formation,  collision  avoidance 
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among  members  within  the  UAV  swarm  and  obstacle  avoidance. 


F total 


N  NN  NO  N  N 

ErpiL  ,  pij  ,  rpik  ,  rpij 

r  virtual  '  /  j  /  j  r  formation  '  /  j  /  j  r  obstacle  '  /  ^  /  j  r  collision) 
i=l  i=l  j= 1  i= 1  k=i  i=l  j= 1 


3±i,  (2-1) 


where  %  and  j  are  indices  of  UAVs  within  the  swarm  (a  total  of  N ),  and  k  is  the  index  of 
obstacles  (a  total  of  0).  L  represents  the  virtual  leader. 

The  potential  field  vector  diagram  is  shown  in  Figure  2.5. 
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Figure  2.5:  Potential  held  vector  diagram 


The  virtual  leader  controls  the  movement  of  the  formation.  The  potential  held  function 
which  is  designed  to  maintain  the  desired  distance  from  the  virtual  leader  is: 


F 'virtual  kvirtUal  ( di 


di0) 


(2.2) 


di  is  the  actual  distance  of  the  ith  UAV  from  the  virtual  leader  L,  and  di0  is  the  desired 
distance.  The  interaction  with  other  UAVs  also  affects  the  formation.  The  potential  held 
due  to  the  jth  UAV  is: 

F formation  ~  ^ form  ( dij  ~  dijQ )  (2-3) 

For  collision  avoidance  the  potential  held  is  designed  as  follows: 


11 


Fcollision  =  g7j|  f°r  IMiill  <  (2-4) 

A  safety  sphere  of  radius  rsa„  is  assumed  around  the  UAV.  is  the  distance  between 
UAVs  z  and  j.  If  another  UAV  enters  the  sphere  this  factor  increases,  and  converges  to 
infinity  at  the  centre  of  the  sphere. 

Similarly,  for  obstacle  avoidance  the  field  is  modeled  as  follows: 


pik 

obstacle 


/or 

0  otherwise 


(2.5) 


dki  is  the  distance  between  UAV  i  and  the  fc-tli  obstacle.  Kcou  and  K0bstaxe  gains  that  need 
to  be  tuned. 

The  resultant  magnitude  and  direction  of  the  potential  field  is  obtained  by  summing 
the  individual  potential  fields,  ffere  the  magnitude  of  the  field  is  restricted  to  a  maximum 
quantity,  while  the  direction  is  kept  the  same.  This  is  done  to  limit  the  speed  of  the  UAV. 
A  trajectory  is  then  generated  using  this  resultant  potential  held.  The  potential  held  de¬ 
signed  here  is  continuous,  and  simulation  results  demonstrate  that  this  method  successfully 
achieves  formation  flight  along  with  collision  and  obstacle  avoidance.  The  UAVs  avoid  a 
local  minimum  and  head  towards  their  goal,  which  is  a  stable  minimum. 


In  [Scherer  et  al.  (2008)]  a  framework  for  hying  an  unmanned  helicopter  close  to  the 
ground  is  described,  avoiding  even  small  obstacles  such  as  wires.  It  consists  of  a  slow  global 
path  planner,  a  high  frequency  local  reactive  obstacle  avoidance  algorithm  and  a  low  level 
speed  controller.  The  sensor  used  is  a  ladar  that  can  sense  small  obstacles  from  ranges 
of  100m.  Information  about  the  environment  is  given  to  the  algorithm  through  Evidence 
Grids,  which  are  a  map  of  the  environment  that  can  be  updated  after  every  sensor  scan 
[Martin  &  Moravec(1996)].  A  layered  architecture  with  deliberate  path  planning  running  at 
low  frequency  and  reactive  obstacle  avoidance  running  at  high  frequency  is  used.  The  lowest 
layer  is  the  speed  controller  which  accelerates  or  decelerates  the  vehicle  based  on  how  close 
the  obstacle  is. 


The  reactive  local  obstacle  avoidance  algorithm  uses  the  potential  held  approach.  The 
control  law  consists  of  an  attraction  factor  towards  the  goal  and  a  repulsion  factor  from 
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the  obstacles.  These  factors  are  calculated  based  on  the  distance  and  angle  measures.  The 
attraction  to  the  goal  is  directly  proportional  to  the  angle  to  the  goal,  and  inversely  pro¬ 
portional  to  the  exponential  of  the  distance  from  the  goal.  The  repulsion  from  obstacles  is 
inversely  proportional  to  the  exponentials  of  both  the  distance  and  the  angle  to  the  obstacle: 


attract  {goal)  =  kg^g  (e  Clda  +  c2) 

(2.6) 

repulse  {obstacle)  =  k0i\)0  (e~C3do^j  ^e_C4^°^ 

(2.7) 

where  g  and  dg  are  the  angle  and  distance  to  the  goal,  respectively,  and  Vb  and  dQ  are 
the  angle  and  distance  to  the  obstacle.  kg,  k0,  ci,  C2,  C3,  C4  are  parameters  to  be  found. 
These  parameters  are  found  by  training  the  system  against  a  human  pilot  and  then  tuned 
[Hamner  et  al.  (2006)]. 

An  angular  acceleration  command  is  formulated  by  summing  these  factors  and  then 
damping  it  with  the  current  angular  velocity  as  follows: 

(f>  =  —b<j)  —  attract  (g)  +  ^  repulse  ( o )  (2.8) 

oeo 

Also,  the  algorithm  maneuvers  in  both  horizontal  and  vertical  planes  before  one  of  them 
becomes  clear  of  obstacles  and  then  the  UAV  chooses  that  plane  to  travel  in.  This  algorithm 
has  been  extended  to  the  3D  case.  The  obstacles  considered  by  the  algorithm  are  limited 
by  a  box  shape  constraint  to  maintain  computation  tractability.  The  algorithm  was  imple¬ 
mented  in  an  unmanned  helicopter.  It  was  found  that  obstacle  avoidance  was  successful  even 
when  the  helicopter  flew  at  low  altitudes  (8m)  and  at  high  speeds  (3m/s  to  10  m/s).  The 
helicopter  avoided  even  thin  wires.  However,  this  method  does  not  explicitly  avoid  moving 
obstacles. 

However  the  potential  field  method  has  some  inherent  limitations  [Koren  &  Borenstcin(1991)]. 
A  major  drawback  of  this  method  is  that  it  is  possible  for  the  UAV  to  get  caught  in  a  local 
minimum  i.e.  the  UAV  gets  caught  among  obstacles  before  reaching  the  goal.  It  is  also 
difficult  for  this  method  to  find  paths  through  narrow  passages.  Additionally,  the  potential 
function  needs  to  be  designed  heuristically  for  every  problem,  and  finding  it  becomes  difficult 
for  large  obstacle-laden  spaces  with  many  motion  constraints. 
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2.1.4  Minimum  Effort  Guidance 

The  problem  of  flying  a  UAV  with  vision  based  guidance  can  be  seen  as  a  control  minimizing 
Proportional  Navigation  (PN)  guidance  problem  in  the  absence  of  obstacles.  PN  Guidance 
is  used  in  missile  guidance,  [Zarchan(1994)]  and  the  problem  of  a  UAV  pursuing  its  goal 
may  be  interpreted  as  a  similar  problem.  But  when  obstacles  are  to  be  avoided,  multiple  PN 
guidance  problems  need  to  be  solved.  A  collision  avoidance  scheme  based  on  PN  guidance 
is  presented  in  [Han  &  Bang(2004)].  However,  this  scheme  leads  to  a  jump  in  the  control 
effort  every  time  a  new  target  is  pursued.  Instead,  a  single  Minimum  Effort  Guidance 
(MEG)  approach  minimizes  the  control  effort  along  with  avoiding  collisions  for  multiple 
targets  [Watanabe  et  al.(2006)].  In  other  words,  the  control  effort  is  minimized  for  the  entire 
trajectory  from  the  initial  point  to  the  goal  point  via  the  obstacle  aiming  point,  leading  to  a 
lower  overall  control  effort.  A  collision  cone  approach  is  used  to  detect  potential  collisions, 
for  which  an  Extended  Kalman  Filter  (EKF)  [Crassidis  &  Junkins(2004)]  is  used  to  estimate 
the  relative  distance  from  the  UAV  to  the  obstacle.  The  vehicle  dynamics  are  given  by: 


where  the  velocities  and  positions  are  measured  w.r.t.  a  local  fixed  frame. 

If  the  destination  point  is  [xd  Vd  zd]T,  the  terminal  conditions  are: 

y(tf)  =  Vd  (2.11) 

z(tf)  =  zd  (2.12) 

where  the  terminal  time  is 

xd  —  xv(t) 

tf  =  t+— - —  (2.13) 

u 

The  relative  position  of  the  obstacle  with  respect  to  the  vehicle  position  is 

A  =  Aofe.s-  Xv  (2.14) 
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Aiming  point 


Figure  2.6:  Reaching  the  goal  and  avoiding  an  obstacle  using  MEG 
Also,  for  stationary  obstacles 

X  =  —V  (2.15) 

where  V  is  the  vehicle  velocity.  The  collision  safety  boundary  is  a  sphere  of  radius  d  meters 
around  the  obstacle. 

A  collision  cone  [Chakravarthy  &  Ghose(1998)]  in  two  dimensional  space  is  formed  by  a 
set  of  tangents  from  the  UAV  to  the  safety  boundary  of  the  obstacle,  as  shown  in  Figure 
2.6.  If  the  velocity  vector  is  contained  within  the  collision  cone,  the  obstacle  is  said  to  be 
critical,  and  an  alternate  maneuver  is  to  be  calculated.  The  aiming  point  Xap  is  a  point 
that  the  UAV  must  maneuver  to  so  that  the  minimum  safety  distance  is  maintained.  This 
may  be  found  using  the  Collision  Cone  Approach.  Time-to-go  to  the  aiming  point  tgo  is  also 
found.  Additional  time-to-go  criteria  are  specified,  which  point  out  that  collision  must  only 
be  avoided  if  time-to-go  is  within  certain  range: 


tg0  —  t  <T 

(2.16) 

o 

A 

c-f- 

o 

A 

'-b 

(2.17) 

where  time  T  should  be  small  enough  so  that  collision  avoidance  is  done  only  when  there  is 
urgency. 
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The  PN  guidance  law  is  derived  by  solving  the  following  optimization  problem  for  control 
minimization  for  each  aiming  point  obtained: 

tgo  tgo 

min  Joa  —  -  J  aT(t)a(t)dt  =  -  J  (a2y(t)  +  a2{t))dt  (2-18) 

to  t-o 

subject  to  vehicle  dynamics  with  terminal  conditions 


Vvitgo)  Uapi  Zy(tgo)  ^ap 

The  resulting  optimal  guidance  law  is 
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(2.20) 


The  problem  of  reaching  destination  is  handled  in  another  PN  guidance  problem  with  the 
terminal  conditions: 


y{tf )  =  Vd ,  z(tf )  =  zd  (2.21) 

The  optimal  control  obtained  from  the  PN  Guidance  method  is  only  piecewise  continuous, 
with  a  jump  between  targets. 

MEG  handles  all  the  terminal  conditions  within  one  problem  [Ben-Asher(1993)].  The  op¬ 
timal  control  is  continuous  and  piecewise  linear.  This  method,  therefore,  yields  a  lower  cost. 
The  optimization  problem  remains  the  same  and  all  the  terminal  conditions  are  considered 
in  the  problem.  The  control  law  is  found  by  cubic  interpolation  of  the  single  condition  case. 
The  resulting  optimal  control  law  is 
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(2.22) 


We  conducted  simulation  studies  of  the  sequential  PN  and  the  MEG  methods.  The  plots 
2.7,  2.8  and  2.9  show  the  path  and  control  efforts  in  y-  and  z-directions  respectively  by  the 
sequential  PN  method. The  plots  2.10,  2.11  and  2.12  show  the  path  and  control  efforts  in  y- 
and  z-directions  respectively  using  the  MEG  method. 


Path  found  by  Sequential  PN 


Figure  2.7:  Path  found  by  Sequential  PN  in  3  dimensions 

These  plots  show  that  the  control  effort  demanded  by  the  MEG  is  much  lesser,  both  in 
terms  of  overall  control  as  well  as  the  peak  in  control.  The  MEG  is  thus  a  good  choice  if  a 
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t 


Figure  2.8:  Control  for  Sequential  PN  in  Y-clirection 

minimum  effort  collision  avoidance  path  is  desired. 

In  [Watanabe  et  al.(2006)],  both  PN  Guidance  and  Minimum  Effort  Guidance  are  used  to 
solve  the  same  problem.  The  cost  is  found  to  be  lower  in  MEG.  Therefore,  MEG  is  found  to 
be  a  better  method  in  terms  of  the  control  minimization  achieved.  However,  an  assumption 
made  in  this  method  is  that  the  obstacles  are  stationary.  Therefore,  this  method  needs  to 
be  extended  for  avoiding  collisions  with  moving  obstacles. 
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Figure  2.9:  Control  for  Sequential  PN  in  Z-direction 


Path  found  by  MEG 


Figure  2.10:  Path  found  by  MEG  in  3  dimensions 
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acceleration  in  z  acceleration  in  y 
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Figure  2.11:  Control  for  MEG  in  Y-direction 


t 


Figure  2.12:  Control  for  MEG  in  Z-direction 
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2.2  Local  Collision  Avoidance  Algorithms 


Local  collision  avoidance  algorithms  deal  only  with  the  problem  of  avoiding  collisions  with 
obstacles  as  and  when  they  are  detected.  These  algorithms  do  not  retain  global  information, 
that  is  they  do  not  require  knowledge  of  the  entire  environment,  or  the  initial  and  goal 
points.  The  information  about  the  immediate  environment,  and  nearby  obstacles  (fixed  and 
moving)  are  provided  to  the  algorithm  by  onboard  sensors/ earner  as.  This  information  is 
often  sufficient  to  compute  an  avoidance  maneuver  for  the  UAV.  It  must  be  emphasized 
that  these  algorithms  can  be  imbedded  into  any  global  path  planning  algorithms,  under  the 
assumption  that  after  avoiding  the  obstacle,  the  UAV  comes  back  to  the  global  path  as  soon 
as  possible. 

2.2.1  Nonlinear  Model  Predictive  Control  Approach 

Model  Predictive  Control  (MPC)  [Camacho  &  Bordons(1999)]  has  gained  popularity  in  re¬ 
cent  years  as  a  control  approach  for  nonlinear  dynamical  systems.  This  approach  handles 
realistic  system  constraints  such  as  input  saturation  and  state  constraints  and  is  found  to 
be  suitable  for  path-planning  problems  in  complex  environments  [Leung  et  al.  (2006)].  An 
MPC  scheme  is  implemented  by  [Shim  et  al.(2006)]  to  achieve  online  collision  avoidance  in 
UAVs.  Since  MPC  performs  online  optimization  over  a  finite  receding  horizon,  it  can  ac¬ 
count  for  future  environment  changes.  Collision  avoidance  is  built  into  the  optimization 
problem,  which  performs  reference  trajectory  tracking  and  obstacle  avoidance  in  a  single 
module.  When  a  collision  is  predicted  to  occur,  a  safe  trajectory  that  avoids  the  impending 
collision  is  computed.  (Figure  2.13) 

In  the  MPC  formulation,  an  optimal  control  input  sequence  over  a  finite  receding  horizon 
N  must  be  found  that  minimizes  a  cost  function  [Shim  &  Sastry(2007)]  That  is,  find 

u  (4) ,  k  —  i,  i  +  1, ...,  i  +  N  —  1 

Such  that 

u  (4)  =  arg  min  V  (. x ,  4,  u)  (2.24) 

where 

tk+N- 1 

V(x,tk,u)=  L(x(i)  ,u(i))  +  F  (x(tk+N))  (2.25) 

i=tk 


(2.23) 
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Initial  point 

Figure  2.13:  Trajectory  tracking  and  re-planning  using  MPC 


Lis  a  positive  definite  cost  function  and  F  is  the  terminal  cost.  The  cost  function  L  is  chosen 
as: 

1  i  o 

L  (x,  u)  =  -  (xr  -  x)T  Q  ( xr  -  x)  +  -ujRur  +  S  (x)  +  ^2  P  ( XV ,  Vi)  (2.26) 

2  1  i=i 


The  first  term  in  the  cost  function  ensures  that  any  deviation  from  the  reference  state 
results  in  a  large  value  of  cost,  and  therefore  is  penalized.  Similarly  the  second  term  penalizes 
high  control  inputs.  The  term  S(x)  penalizes  states  that  are  outside  the  allowable  range. 
The  last  term  is  a  potential  function  term  to  be  included  for  obstacle  avoidance.  It  is  chosen 
as  follows: 


P  (xv,  rji)  = 


(2.27) 


(xv  -  rji)  G  (xv  -  rji)  +  e 
where  xv  G  i?3  is  the  position  of  the  UAV,  and  rji  is  the  position  of  the  Z-th  obstacle  out 
of  O  obstacles.  This  penalty  function  increases  as  ||x„  —  rji ||  decreases.  G  is  positive  definite 
and  e  is  a  quantity  that  is  kept  positive  to  prevent  P  from  being  singular  when  \\xv  —  iji\\  0. 
The  potential  function  term  may  be  chosen  to  be  enabled  only  when  ||x„  —  rft\\  <  crmin,  a 
minimum  safety  distance  to  be  maintained.  A  new  trajectory  is  then  planned.  Including 
collision  avoidance  into  the  optimization  step  reduces  the  risk  of  the  UAV  falling  into  a  local 
minimum,  since  MPC  looks  ahead  and  optimizes  over  a  finite  horizon. 
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The  obstacles’  predicted  position  after  k+N-1  steps  is  required  (N  is  the  horizon)  in 
order  to  avoid  the  obstacle.  If  the  current  position  and  velocity  Vi  of  the  obstacle  may  be 
estimated,  the  position  of  the  obstacle  after  Np  steps  (prediction  horizon)  may  be  found  at 
the  kth  step: 

Vi  (4+i)  =  Vi  (4)  +  A tvi  (4)  (^-1)  (2.28) 

Control  saturation  is  taken  into  account  during  the  online  optimization  process.  Addition¬ 
ally  a  tracking  feedback  controller  in  the  loop  will  track  the  reference  without  any  error  in 
the  presence  of  modeling  uncertainties. 

A  dual  mode  strategy  is  followed  in  order  to  track  a  reference  trajectory,  as  well  as  avoid 
collisions.  In  normal  flight,  parameters  are  chosen  so  as  to  achieve  tracking  performance  and 
good  stability.  In  the  emergency  evasive  maneuver  case,  the  parameters  are  chosen  so  as  to 
generate  a  trajectory  that  will  avoid  collision  at  all  cost.  During  evasion,  large  control  effort 
and  large  deviations  from  reference  are  allowed. 

Results  of  simulations  in  [Shim  &  Sastry(2007)]  indicate  that  this  method  is  capable  of 
avoiding  hostile  obstacles  flying  at  high  speeds  (  100  kmph)  and  with  different  heading  an¬ 
gles.  This  method  was  implemented  successfully  in  unmanned  helicopters.  A  disadvantage 
of  this  method  is  that  MPC  is  quite  computation  intensive,  and  may  not  be  suitable  for 
online  implementation  on  small  UAVs.  An  extension  of  this  approach  can  be  towards  col¬ 
lision  avoidance  with  maneuevering  obstacles.  This  would  require  an  estimator  and  some 
knowledge  of  the  dynamics  of  the  obstacle. 

2.2.2  Vision-based  Neural  Network  Approach 

A  vision  based  Grossberg  Neural  Network  (GNN)  [Grossberg(1988)j  scheme  is  used  for  local 
collision  avoidance  [Wang  et  al.(2007)].  GNNs  are  nonlinear  competitive  neural  networks. 
These  are  able  to  explain  the  working  of  human  vision,  and  have  been  used  in  a  variety  of 
vision  based  applications,  especially  in  pattern  recognition  [Carpenter  &  Grossberg(1991)]. 
GNNs  may  be  used  for  UAV  vision  based  navigation.  A  combination  of  Visibility  Graphs 
and  GNNs  is  used  to  achieve  online  collision  avoidance. 


23 


A  two-layer,  dual-mode  control  architecture  achieves  a  formation  of  UAVs  as  well  as  colli¬ 
sion  avoidance.  The  top  layer  generates  a  reference  trajectory  and  the  lower  layer  tracks  this 
reference  taking  into  account  the  dynamics  of  the  vehicle.  In  an  obstacle-free  environment, 
“Safe  Mode”  operation  is  carried  out,  which  develops  and  maintains  a  formation  of  UAVs. 
When  obstacles  are  detected  using  an  on-board  sensor,  the  “Danger  Mode”  is  activated, 
which  finds  the  shortest  path  out  of  the  danger  zone. 


In  the  “Safe  Mode” ,  the  reference  trajectory  is  to  be  generated  so  that  the  UAVs  achieve 
and  maintain  the  desired  formation.  The  relative  dynamics  between  the  UAVs  is  used  to 
develop  an  infinite  time  optimal  scheme  [Bryson  &  Ho(1975)]  of  formation  in  a  centralized 
way.  In  order  to  achieve  this,  the  following  cost  function  is  to  be  minimized: 


J 


Xd )  +  uj  Rur 


dt 


(2.29) 


Subject  to 


xr  =  Arxr  +  Brur  (2.30) 

xr  is  the  relative  state  (relative  position  and  relative  velocity  between  two  UAVs)  and  Xd  is 
the  desired  value  of  state.  ur  is  the  relative  control  i.e.  the  resultant  acceleration  between 
two  UAVs.  This  formulation  attempts  to  attain  a  formation  as  well  as  minimize  the  control 
effort  for  this.  The  reference  trajectory  is  generated  online  at  every  step. 

The  danger  mode  is  activated  when  an  obstacle  is  sensed.  In  this  situation,  the  forma¬ 
tion  is  allowed  to  break.  The  UAVs  must  avoid  collisions  with  obstacles  as  well  as  with  the 
other  UAVs  in  the  formation.  The  danger  mode  operation  uses  a  combination  of  Visibility 
Graphs  [Lavalle(2006)]  and  vision  based  Grossberg  Neural  Networks  (GNN).  A  buffer  zone  is 
created  around  the  obstacles.  A  visibility  graph  of  the  environment  is  formed  by  connecting 
all  mutually  visible  vertices  of  the  obstacle  buffer  zones  together.  In  two  dimensional  envi¬ 
ronments  the  shortest  distance  paths  are  obtained  by  moving  in  straight  lines  and  turning  at 
the  vertices  of  obstacles.  Therefore,  as  part  of  the  GNN,  neurons  are  placed  at  the  vertices 
of  each  obstacle’s  buffer  zone.  Figure  2.14  shows  neuron  placement,  visibility  graph  and  the 
re-planned  trajectory. 
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UAV 


neurons 


Re -planned  path 


Figure  2.14:  Danger  Mode  operation  using  visibility  graph  and  GNNs 


The  activity  of  each  neuron  depends  upon  excitation  received  from  other  neurons  as  well 
as  excitation  from  the  goal  point.  The  activity  is  calculated  from  a  shunting  equation: 


dx 


—jp  =  - axi  +  (b-  Xi)  (  E  +  ^ 


(2.31) 


3= 1 


where 


E  —  E\  +  E'2 


(2.32) 


E,  =  “  (2.33) 

dp 

!  100,  if  the  neuron  is  on  destination 

(2.34) 

0,  otherwise 

Xi  is  the  activity  of  the  ith  neuron,  WijXij  is  excitation  due  to  neighboring  neuron,  where 
Wij  =  (/i/dij).  dij  is  the  distance  between  UAVS  i  and  j.  dp  is  the  perpendicular  distance 
of  the  vertex  from  the  line  joining  the  UAV  and  the  target.  E  is  the  excitation  composed 
of  two  parts.  E\  is  the  excitation  due  to  closeness  of  the  vertex  from  the  present  path,  a 
and  p  are  weights  that  must  be  tuned  correctly  so  that  the  deviation  from  current  path  and 
closeness  to  goal  are  weighed  correctly.  The  neurons  nearest  to  the  goal  and  nearest  to  the 
current  path  have  the  highest  values  of  activity.  Thus,  by  following  the  vertices  with  highest 
activities,  the  UAV  is  able  to  get  out  of  the  danger  mode.  The  path  followed  will  be  the 
shortest  distance  path.  Collision  avoidance  with  other  UAVs  is  achieved  in  the  following 
way.  When  a  potential  collision  is  sensed,  the  UAV  with  lower  index  creates  a  buffer  zone 
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around  the  UAV  with  higher  index  and  attempts  to  avoid  it. 


In  the  lower  layer,  tracking  the  reference  generated  by  both  the  Safe  Mode  and  the  Danger 
Mode  is  done  using  a  Model  Predictive  Controller  (MPC)  [Camacho  &  Bordons(1999)].  This 
method  consists  of  finding  the  optimal  control  input  sequence  to  minimize  a  cost  function 
at  every  step.  The  cost  function  here  is  formulated  such  that  the  actual  output  tracks  the 
reference  output,  along  with  control  minimization.  This  method  also  takes  into  account 
practical  vehicle  constraints.  The  cost  function  to  be  minimized  at  the  kth  step  is: 

Jk  =  [y  (4)  -  Vd  (4)]T  Qk  [y  (4)  -  yd  (4)]  +  A U  (4)  RkAU  (4)  (2.35) 

y  is  the  actual  output,  yci  is  the  desired  output  and  A U  is  the  control  history.  Qk  and  Rk 
are  weighting  matrices  to  be  chosen  appropriately. 

Simulation  results  in  [Wang  et  al.(2007)]  show  that  the  UAVs  developed  a  desired  forma¬ 
tion  and  successfully  re-planned  trajectories  to  avoid  obstacles  along  the  way.  Cooperative 
collision  avoidance  among  UAVs  is  also  achieved.  A  possible  extension  of  this  method  is  the 
case  of  non-cooperative  collision  avoidance.  This  can  be  implemented  with  an  estimator  to 
find  the  hostile  obstacles’  velocity  and  position. 

2.2.3  Conflict  Detection  and  Resolution 

UAV  collision  avoidance  may  be  percieved  as  a  Conflict  Detection  and  Resolution  (CD&R) 
problem.  CD&R  methods  are  used  widely  for  Air  Traffic  Control  [Kuchar  &  Yang(2000)]. 
These  methods  predict  the  possibility  of  a  conflict  between  two  aircraft,  and  compute  a  ma¬ 
neuver  strategy  for  the  UAV  such  that  conflict  is  avoided.  One  approach  [Park  et  al.(2008)]  is 
to  perform  conflict  detection  by  the  Point  of  Closest  Approach  (PCA)  [Krozel  &  Peters(1997)] 
method.  For  conflict  resolution,  a  vector  sharing  resolution  method  is  used.  Conflict  is  de¬ 
fined  as  “a  predicted  violation  of  a  separation  assurance  standard” .  It  is  assumed  that  every 
UAV  has  information  about  every  other  UAV.  A  protection  zone  is  defined  as  a  sphere  of 
a  specified  distance.  If  the  protection  zone  is  violated,  the  UAVs  must  maneuver  such  that 
conflict  is  avoided. 

The  UAVs  are  modeled  as  point  masses  flying  with  constant  velocities.  The  point  mass 
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UAV  equations  are: 


V  = 


(2.36) 


X 

'  VH ' 

cosy 

y 

= 

VH 

sin  7 

z 

V 

sin  6 

(2.37) 


7  = 


gtsauj) 


V, 


(2.38) 


H 


where  6  is  the  UAV’s  pitch  angle,  7  is  heading  angle  and  0  is  the  bank  angle.  Pitch  angle 
and  heading  angles  are  commanded  as  follows,  where  N  and  M  are  time  constants  in 


(2.39) 
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N 
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Figure  2.15:  Conflict  detection  using  PCA 

ft  is  assumed  that  two  UAVs  are  in  encounter  with  each  other  as,  shown  in  Figure  2.15, 
and  they  are  heading  in  their  velocity  direction,  i.e.,  there  is  no  sideslip,  c  is  the  relative 
velocity  between  the  two  UAVs,  and  r  is  the  relative  distance.  r„  is  the  missed  distance, 
which  is  found  from  the  PCA  method  as 


r  m  =  c  x  (r  x  c) 


(2.40) 


The  time  of  closest  approach  is  found  to  be 

r.c 

c.c 


(2.41) 


It  is  found  that  when  the  time  of  approach  r  >  0  there  is  a  chance  of  conflict.  When 
r  <  0  there  is  no  chance  of  collision.  Therefore,  when  r  >  0  the  safety  distance  is  checked. 
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If  the  magnitude  of  the  missed  distance  vector  is  less  than  the  safety  measure  (rm  <  rsafe ), 
there  is  a  conflict,  which  must  be  resolved. 

For  conflict  resolution,  a  resolution  maneuver  must  be  computed,  which  lies  along  the 
missed  distance  vector,  as  shown  in  Figure  2.16.  Va  and  Vb  are  the  actual  velocity  directions 
of  UAV  A  and  UAV  B  respectively. Ua  and  Ub  are  the  velocity  directions  the  UAV  must  go 
along  so  that  the  distance  between  the  UAVs  is  rsafe.  rysA  and  vvsb  are  the  vectors  of  each 
UAV  along  the  missed  distance  vector  such  that  \rsafe\  =  |ry5^|  +  ry ,s b  +  \rm\.  The  slower 
UAV  takes  more  sharing. 


UAV  B 


UAV  A 


Figure  2.16:  Vector  sharing  resolution  to  resolve  the  conflict 


It  is  proposed  by  [Merz(1991)]  that  the  optimal  maneuver  to  resolve  the  conflict  consists 
of  an  acceleration  along  the  missed  distance  vector  .  The  commands  to  the  UAV  are  decided 
based  on  the  range  of  the  LOS  angle  and  the  required  pitch  angle.  The  LOS  angle  is 
calculated  as: 


7  =  sig 


cos 


Vh-Uh 

\Vh\ 


(2.42) 


Depending  on  the  range  of  the  LOS  angle,  the  bank  angle  command  is  given  suitably.  The 
time  constant  N  is  set  as  1  second. 


The  required  pitch  angle  is: 


9req  =  tan  1 


Uv 


I U, 


(2.43) 


H\ 


Depending  on  its  range  the  time  constant  M  is  set.  Simulations  done  in  a  non-cooperative 
scenario  in  [Park  et  al.  (2008)]  show  that  the  UAV  successfully  detects  conflict  and  maneuvers 


such  that  conflict  is  avoided.  However,  this  algorithm  assumes  perfect  information  between 
the  UAVs,  which  is  not  a  realistic  assumption.  Communication  links  used  at  the  present 
time  to  relay  information  among  UAVs  cannot  guarantee  perfect  information  transfer.  In 
addition,  this  algorithm  will  be  difficult  to  implement  for  a  maneuvering  obstacle,  since  the 
algorithm  is  developed  for  an  obstacle  moving  with  constant  velocity.  Moreover,  the  velocity 
of  the  UAV  itself  is  assumed  to  be  constant,  which  limits  the  possibilities  of  this  method. 

2.3  Conclusions 

Much  of  the  benefits  of  deploying  UAVs  can  be  derived  from  autonomous  missions.  Path 
planning  with  collision  avoidance  is  an  important  problem  which  needs  to  be  addressed  to 
ensure  safety  of  such  vehicles  in  autonomous  missions.  An  attempt  has  been  made  in  this 
review  paper  to  present  a  brief  overview  of  a  few  promising  and  evolving  ideas  such  as  graph 
search,  RRT,  potential  field,  model  predictive  control,  vision  based  algorithms,  minimum 
effort  guidance  etc.  Note  that  there  are  several  requirements  that  an  algorithm  must  satisfy 
in  order  to  solve  the  online  collision  avoidance  problem  completely.  A  few  key  issues  that 
need  to  be  addressed  in  a  good  collision  avoidance  algorithms  include: 

•  Collision  avoidance  with  fixed  and  moving  obstacles-  both  in  cooperative  and  non- 
cooperative  flying 

•  Solution  of  the  problem  taking  the  vehicle  dynamics  into  account,  including  state  and 
input  constraints  (many  of  the  current  algorithms  are  based  on  only  kinematics) 

•  Development  of  fast  algorithms,  which  can  be  implemented  online  with  limited  onboard 
processor  capability 

•  Capability  to  sense  and  avoid  even  small  obstacles  (such  as  electric  power  lines,  small 
birds  etc.) 

•  Robustness  for  issues  such  as  limited  information  of  the  environment,  partial  loss  of 
information  etc. 

In  addition  to  the  above  issues,  there  are  many  other  issues  for  successful  deployment 
of  UAVs,  such  as  requirement  for  light  weight  equipments,  power  efficiency  (for  high  en¬ 
durance),  stealthiness  etc.  Although  an  attempt  has  been  made  in  this  paper  to  give  an 
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overview  of  some  of  the  recently  proposed  techniques  which  partially  address  some  of  these 
issues,  promising  algorithms  satisfying  many  of  these  requirements  simultaneously  is  yet  to 
be  developed.  Additionally,  some  of  the  assumptions  behind  the  proposed  algorithms  (such 
as  non- maneuvering  constant  speed  flying  objects,  appearance  of  one  obstacle  at  a  time,  per¬ 
fect  information  about  the  environment  etc.)  are  not  realistic  and  hence  need  to  be  relaxed. 
A  lot  of  research  is  being  carried  out  worldwide  to  design  collision  avoidance  systems  that 
address  many  of  these  important  concerns. 
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Chapter  3 

Problem  Formulation 


In  Chapter  2  we  discussed  various  methodologies  used  to  achieve  collision  avoidance  in  UAVs. 
In  this  chapter  we  formulate  the  collision  avoidance  problem  for  the  UAV. 


3.1  Modeling 

The  motion  of  the  UAV  is  modeled  via  simple  kinematics  i.e., 


x 

y 

z 

it 

v 

w 


u 

V 

w 

0 


(3.1) 


(3.2) 


All  of  these  are  measured  w.r.t.  the  body  frame  as  shown  in  Figure  3.1 
The  controls  are  ay  and  az  .  Note  that  the  acceleration  in  x-direction  is  an  engine  control 
and  therefore  is  sluggish.  Hence  we  assume  that  the  guidance  loop  has  no  control  over  the 
UAV’s  motion  in  the  body  x-axis. 
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u  =  constant 


Figure  3.1:  UAV  velocities  in  the  body  frame 

3.2  Detecting  and  Avoiding  Collision 

The  UAV  must  detect  an  imminent  collision  and  avoid  it  effectively.  The  “collision  cone” 
[Chakravarthy  &  Ghose(1998)]  is  an  effective  tool  for  achieving  this.  In  this  approach,  a 
collision  cone  is  constructed  for  every  obstacle  and  analyzed.  The  most  critical  obstacle  is 
one  with  which  collision  will  occur  the  soonest.  A  guidance  law  is  then  used  to  steer  the 
UAV  to  an  aiming  point  Xap  at  the  final  time  tf.  The  collision  cone  approach  is  used  to  find 
Xap  and  tf.  The  construction  of  the  collision  cone  is  shown  in  Figure  3.2. 


Aiming  point  Xap 


A  spherical  safety  boundary  is  assumed  around  the  obstacle.  Xr  is  the  relative  distance 
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between  the  UAV  and  the  obstacle,  and  V  is  the  velocity  of  the  UAV.  The  plane  containing 
Xr  and  V  is  considered  to  check  the  possibility  of  collision.  The  safety  boundary  thus  reduces 
to  a  circle  (3  in  this  plane.  A  collision  cone  is  constructed  by  dropping  tangents  from  the 
UAV  to  the  circle  formed.  If  the  velocity  vector  V  lies  within  this  collision  cone,  the  UAV 
will  violate  /3  in  due  course  and  thus  the  obstacle  is  said  to  be  critical.  V  can  be  expressed 
in  terms  of  the  tangents  r\  and  ^[Watanabe  et  al.  (2006)]  as  follows: 

V  =  ar !  +  br2  (3.3) 

The  collision  criterion  may  therefore  be  stated  as: 

If  a  >  0  AND  b  >  0,  the  obstacle  under  consideration  is  said  to  be  critical 

The  aiming  point  is  then  found  from  the  collision  cone.  First,  the  tangents  r±  and  r2  are 
found  as  follows: 


r'i  =  Xr  +  dui  (3.4) 

r2  =  Xr  +  du2 

The  aiming  point  is  then  determined  in  the  following  way: 

If  a  >  b,  Xap  =  Xv  +  ri  (3.5) 

If  b  >  a,  Xap  =  Xv  +  r2 

Since  the  velocity  in  x-direction,  is  assumed  constant,  the  final  time  tf  can  be  found  as 
follows: 


tf  = 


(Vo,),  -  (*»), 

U 


(3,6) 


The  problem  now  becomes  one  of  guiding  the  UAV  from  Xv  (t0)  =  Xin  to  Xv  (tf)  =  Xd. 
The  collision  avoidance  problem  therefore  becomes  similar  to  a  target  interception  problem. 
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Chapter  4 

Differential  Geometric  Guidance  for 
Collision  Avoidance 


The  problem  formulation  in  chapter  3  discussed  that  the  problem  of  collision  avoidance  be¬ 
comes  a  guidance  problem  with  the  fixed  terminal  conditions,  Xv(tf)  =  Xap.  Let  us  consider 
the  problem  in  two  dimensions,  represented  in  Figure  4.1. 


A  (0.0)  u  B(«.0) 


Figure  4.1:  Velocity  vector  representation  of  the  collision  avoidance  problem  in  two  dimensions 

As  discussed  in  chapter  3,  collision  is  avoided  by  aligning  the  velocity  vector  V  with 
the  aiming  line.  When  the  velocity  vector  is  perfectly  aligned  with  the  aiming  line,  the 
^/-component  of  the  velocity  vector  changes  to  a  new  value,  v*.  Note  that  in  keeping  with 
the  kinematics  of  the  UAV,  the  ^-velocity  u  remains  constant. 
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v*  is  found  as  follows:  The  points  B  ( u ,  0),  E  ( u ,  v*)  and  C  (u,  v)  lie  on  the  line 


11  :  x  —  u 


(4.1) 


The  points  A  (0,  0),  E  ( u ,  v*)  and  Xap  (xap,  yap)  lie  on  the  line  12.  The  equation  of  12  using 
the  two-point  form  of  equation  of  the  line  is: 


,  y  x 
12:  — = - 


Vap  %ap 

The  point  E  is  the  intersection  of  the  lines  11  and  12.  Substituting  (4.1)  into  (4.2): 


(4.2) 


V  = 


Hap 


U 


X, 


(4.3) 


CLP  / 


The  point  Xap  is  found  from  the  collision  cone  described  in  chapter  3,  and  u  is  a  constant 
velocity.  Hence  v*  is  easily  found,  and  is  a  constant. 

The  objective  is,  therefore,  to  find  a  guidance  law  that  will  take  the  y-velocity  v  to  the 
desired  value  v*  in  the  time  tgo  =  (tf  —  t)  .  Keeping  this  in  mind  we  design  a  guidance  law 
based  on  Dynamic  Inversion  (DI),  a  control  strategy  used  for  output  tracking  of  nonlinear 
systems.  The  principle  of  dynamic  inversion  is  to  drive  a  stabilizing  error  dynamics  (chosen 
by  the  designer)  to  zero.  The  main  advantage  of  DI  is  that  it  essentially  guarantees  global 
asymptotic  stability  w.r.t.  the  tracking  error. 

We  now  describe  the  DI  guidance  design.  Let  the  error  be 


E  =  v  —  v* 

Imposing  the  first  order  error  dynamics 


(4.4) 


i.e. 


E  +  KE  =  0 


(v  —  v*)  +  K  {y  —  v*)  =  0 


(4.5) 


(4.6) 


Since  v*  is  a  constant,  and  v  =  ay  from  the  system  dynamics,  the  DI  based  guidance  law 
is  derived  to  be: 


ay  =  —kv  ( v  —  v*) 


(4.7) 
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We  call  (4.7)  the  ’’Dynamic  Inversion  Guidance  law”,  or  the  ’’Differential  Geometric 
Guidance”  (DGG)  law,  since  the  law  is  derived  based  on  the  derivative  of  the  error.  We 
design  the  constant  kv  such  that  the  settling  time  (i.e.  the  time  taken  to  align  the  velocity 
vector  with  the  aiming  line)  is  inversely  proportional  to  the  time-to-go,  i.e. 

kv  =  —  (4.8) 

7~v 

Such  that  settling  time 

Ts  =  4  tv  (4.9) 

Where 

Ts  —  a  (tf  —  t) ,  0  <  ct  <  1  (4-10) 

Such  a  guidance  strategy  ensures  that  a  larger  control  is  generated  for  an  obstacle  that 
is  nearer  (i.e.  the  time-to-go  is  smaller).  The  variation  of  kv  with  the  time-to-go  is  shown  in 
the  plot  below. 


Variation  of  k  with  time-to-go 


Figure  4.2:  Variation  of  kv  with  time-to-go 


36 


The  guidance  strategy  (4.7)  is  proportional  to  the  error  in  the  y- velocity,  and  thus  pro¬ 
duces  a  large  control  input  at  the  beginning  which  effects  quick  settlement  along  the  aiming 
line.  Since  the  control  ay  is  a  function  of  both  the  time-to-go  and  the  error  in  velocity,  if  the 
x-coordinates  of  the  aiming  point  are  very  close  (i.e.  the  time-to-go  is  small),  the  peak  in 
the  control  required  to  effect  the  alignment  is  higher.  Another  factor  influencing  the  control 
is  the  choice  of  a,  which  determines  how  fast  the  trajectory  aligns  along  the  aiming  line.  If 
the  value  of  a  is  close  to  1,  the  settling  is  slow  and  the  peak  in  control  is  low.  However  if 
fast  settling  is  desired,  a  high  value  of  a  will  effect  this  but  with  a  higher  peak  in  control. 
If  the  time-to-go  is  small,  as  well  as  the  value  of  a  is  low,  the  peak  in  control  may  become 
quite  large.  Therefore,  the  value  of  a  must  be  chosen  judiciously  based  on  the  requirement 
of  speed  of  alignment. 
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Chapter  5 

Geometric  Guidance  for  Collision 
Avoidance 


According  to  the  problem  formulation,  the  velocity  vector  V  must  be  aligned  with  the  aiming 
line  Xap.  From  Figure  (5.1),  we  see  that  this  amounts  to  taking  the  aiming  angle  6  to  zero 
in  the  time  tgo  —  tf  —  t.  One  way  to  achieve  this  is  by  using  a  purely  Geometric  Guidance, 
described  as  the  Aiming  Point  Guidance  (APG)  in  [Tsao  et.  al.  (1998)].  We  discuss  the 
Geometric  Guidance  strategy  in  this  chapter. 


A  (0,0)  u  B(«,0) 


Figure  5.1:  Aiming  angle  representation  of  collision  avoidance  problem  in  two  dimensions 
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5.1  Linear  Geometric  Guidance 


The  Aiming  Point  Guidance  (APG)  Law  in  [Tsao  et.  al.(1998)]  aims  to  achieve  a  zero  aiming 
angle  by  explicitly  designing  the  turning  rate  to  be  linearly  dependent  upon  it.  We  accord¬ 
ingly  design  the  guidance  law  such  that  the  acceleration  is  linearly  proportional  to  the  angle 
9,  with  proper  dimensions  for  kv . 


ay  =  kv9  (5.1) 

(5.1)  is  called  the  Linear  Aiming  Point  (LAP)  Guidance,  or  Linear  Geometric  Guidance 
(LGG)  law,  since  the  control  is  linearly  dependent  on  the  aiming  angle  6.  Such  a  guidance 
law  results  in  a  high  turning  rate  at  the  beginning  (when  the  target  is  first  encountered) 
and  quickly  settles  along  the  aiming  line,  instead  of  maneuvering  all  the  way  to  impact. 
Such  a  maneuver  is  an  advantage  when  compared  to  a  conventional  Proportional  Navigation 
Guidance  (PNG)  law.  The  PNG  law  aims  to  minimize  the  line-of-sight  rate,  and  aligns  itself 
to  the  aiming  line  at  the  very  last  time  instant.  Thus,  any  perturbation  or  target  maneuver 
could  result  in  a  large  miss  distance  or  control  saturation  near  the  final  time. 

As  discussed  in  [Tsao  et.  al. (1998)] ,  the  APG  law  works  very  well  when  accurate  predic¬ 
tions  of  the  final  time  Xf  and  aiming  point  Xap  are  possible.  Since  in  our  system  the  velocity 
along  the  x-clirection  is  assumed  to  be  a  constant,  Xap  and  tf  are  found  accurately  using  the 
Collision  Cone  approach  (section  3.2).  Additionally,  since  the  target  is  assumed  to  be  station¬ 
ary,  the  time-to-go  prediction  is  accurate.  It  is  possible  to  extend  these  to  moving  obstacles 
via  simple  prediction  algorithms.  Only  in  the  case  of  a  highly  maneuverable  target  a  high 
precision  prediction  algorithm  is  needed  to  find  the  terminal  conditions.  However  since  UAV 
flight  occurs  in  urban  terrain,  the  targets  (obstacles)  are  in  general  not  highly  maneuverable. 


5.2  Nonlinear  Geometric  Guidance 

We  propose  a  new  Nonlinear  Geometric  Guidance  (NGG)  law  as  follows: 

ay  =  kv  sin  6  (5.2) 
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The  control  is  thus  a  nonlinear  function  of  the  aiming  angle  9.  An  advantage  that  im¬ 
mediately  presents  itself  is  that  the  range  of  the  sine  function  is  [—1, 1]  whereas  the  range  of 
9  is  [—00,00].  This  means  that  the  acceleration  in  NGG  is  always  bounded,  provided  kv  is 
bounded.  Even  if  we  bound  9  to  a  realistic  range  of  [— tt,  7t],  the  NGG  control  will  be  only 
one  third  as  high  as  the  LGG  control  for  the  same  value  of  kv.  We  also  expect  the  NGG 
law  to  give  a  better  performance  in  the  presence  of  autopilot  delays.  The  NGG  may  also  be 
called  as  the  Nonlinear  Aiming  Point  (NAP)  guidance. 

These  advantages  are  due  to  the  nonlinear  dependence  of  control  on  9.  We  will  prove  in 
Chapter  6  that  the  LGG  is  in  fact  an  approximation  of  the  NGG. 
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Chapter  6 

Correlation  between  Differential 
Geometric  Guidance  and  Geometric 
Guidance 


After  independently  discussing  the  differential  geometric  guidance,  linear  geometric  guidance 
and  nonlinear  geometric  guidance,  we  attempt  to  find  a  correlation  between  these  three 
guidance  laws.  This  is  valid  because  the  objective  in  all  the  three  cases  is  the  same,  i.e.  to 
kill  the  aiming  angle  9  and  align  quickly  along  the  aiming  line.  Let  us  once  again  consider 
the  figure  representing  the  collision  avoidance  problem. 


a(o,o)  u  bM) 


Let  us  first  consider  the  DGG  and  LGG  laws.  The  DGG  law  is 
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K  (v  -  V*) 


(6.1) 


The  LGG  guidance  law  is 


ay 


< ;  =  —kv9  (6.2) 

In  order  to  make  the  correlation,  we  assume  that  the  value  of  control  is  the  same  in  both 
the  cases.  We  then  wish  to  find  out  a  relationship  between  kv  and  kv. 

Dividing  (6.1)  by  (6.2)  we  get: 


kv  v  —  v* 

ku 


e 

We  know  that  the  angle  0  between  two  lines  a  and  b  in  two  dimensions  is  given  by: 


(6,3) 


=  COS 


-1 


a  ■  b 


Therefore,  referring  to  Figure  (6.1),  9  can  be  found  as  follows: 

AC-AE  \ 


i.e., 


9  =  cos 


-l 


pen  pa 


(6.4) 


(6.5) 


This  gives  us 


cos  9  = 


/ 

u 

u 

\ 

\ 

V 

V* 

l 

u 

u 

V 

V* 

cos  9  = 


tr  +  vv* 


a/m2  +  v2\Ju 2  +  v*2 


(6.6) 


(6.7) 


6.1  Case  I 

The  Taylor  series  approximation  for  cosO  is  cos 9  =  1  —  fy  +  fr  —  ••• 
Neglecting  powers  of  9  greater  than  and  equal  to  4  we  have: 
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(6.8) 


(6.9) 

(6.10) 

(6.11) 

(6.12) 

(6.13) 

(6.14) 

(6.15) 

(6.16) 
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kv  =  V2kv  (\j{u2  +  v 2)  ( u 2  +  v*2) 


(6.17) 


6.2  Case  II 

We  have  the  relation  sin#  =  \/l  —  cos2  #.  From  (6.7)  we  have: 


sin  #  = 


■u2  +  nv* 


\  \Vu2  +  v2\/u2  +  u*2, 


i.e., 


sin#  = 


•\Ai2  +  v2\Ju2  +  v*2 


v  —  v 


If  sin  #  ps  #  we  get 


0=  TrrTnrij 

V  +  v  \  uz  +  / 


Substituting  this  in  the  LGG  law  (6.2)  we  get 


(6.18) 


(6.19) 


(6.20) 


y  ^  \Vu2  +  V2\/u2  +  v*2 


(■ v  —  n*) 


(6.21) 


Equating  (6.21)  with  the  DGG  law  (6.1)  we  get  the  following  correlation  between  kv  and 
hath,,: 


h  —  h 

rvv  A/7; 


(6.22) 


"  a/m2  +  v2\Ju2  +  u*2\ 

\  u  ) 

This  gives  us  a  relationship  between  the  LGG  and  the  DGG  laws.  Note  that  in  case  I  of 
the  LGG  there  are  two  extra  approximations  i.e.,  the  binomial  approximation  in  (6.11)  and 
neglecting  fourth  powers  of  u  in  (6.12).  Therefore  case  II  is  a  closer  approximation  to  the 
DGG  law.  However,  instead  of  approximating  the  sine  of  the  angle,  the  guidance  law  can  be 
directly  formulated  as 


ay  —  kv  sin  #  (6.23) 

This  is  the  Nonlinear  Geometric  Guidance  law  discussed  in  chapter  5.  Thus  the  NGG 
is  directly  correlated  to  the  DGG  and  the  LGG  is  an  approximation  of  the  DGG,  when  the 
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gains  are  selected  appropriately.  The  NGG  will  therefore  possess  the  advantages  of  DGG  as 
discussed  in  chapter  4.  Additionally,  the  LGG  approximations  in  both  Case  I  and  Case  II 
hold  true  only  while  \9\  «  1.  If  \9\  exceeds  1,  the  approximation  no  longer  holds  true  and 
the  NGG  gives  precise  values,  while  the  control  in  LGG  will  be  higher. 


Figures  6.2  and  6.3  below  show  the  variation  of  kv  with  time-to-go,  and  kv  with  time-to- 
go. 
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Variation  of  k  with  time-to-go 


Figure  6.2:  Variation  of  kv  with  the  time-to-go 


Plot  of  ky  vs.  time-to-go  for  LAP 


Figure  6.3:  Variation  of  kv  with  the  time-to-go 
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Chapter  7 

Extension  of  Differential  Geometric 
and  Geometric  guidance  to  3D 
Scenario 


With  the  2D  collision  avoidance  problem  satisfactorily  solved,  we  look  for  a  solution  to  the 
more  realistic  3D  collision  avoidance  problem.  The  aiming  point  Xap  and  the  time-to-go  tgo 
are  found  from  the  collision  cone  as  discussed  in  Chapter  3.  The  velocity  vector  must  be 
aligned  with  the  aiming  line  in  the  time  tgo.  This  problem  is  represented  in  3D  in  Figure  7.1. 
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The  angle  6  now  needs  to  be  killed  in  three  dimensions.  The  solution  is  based  on  the 
principle  that  if  we  kill  the  projections  of  the  angles  in  two  perpendicular  planes  X Y  and 
XZ ,  the  alignment  occurs  in  three  dimensions.  This  is  valid  because  the  x- velocity  is  a 
constant.  Therefore  the  controls  ay  in  the  XY  plane  and  az  in  the  XZ  plane  are  found  in 
the  same  way  as  in  the  2D  case  i.e. 


and 


ay  =  —kv  (v  —  v*) 


(7.1) 


az  =  -kw  (w  -  w *)  (7.2) 

The  factors  kv  and  kv  are  designed  in  the  same  way  as  described  in  Chapter  4,  i.e., 


Such  that  settling  time, 


Tv 


(7.3) 


T  =4  r 

1  Si  ^  '  V 


Where 


TSl  =  a  [tf  —  t) ,  0  <  a  <  1 


Similarly, 


k 


W 


1 

7~w 


And 


(7.4) 

(7.5) 


Where 


T, 


S  2 


4t 

^ 1  w 


(7.6) 


Tn=P(t,-t), 0<P<1  (7.7) 

The  equations  (7.1)  and  (7.2)  are  the  DGG  laws  in  3D.  Similar  to  the  2D  case,  the  LGG 
and  NGG  laws  are  formulated  as  follows: 

LGG  Laws: 
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(7.8) 


0>y  kVOy 


Where 


h  —  h 

rvv  rvv 


Qjz  kw0  z 


/U2  +  V2\JU2  +  V*2 


(7.10) 


h  —  k 


'u2  +  w2\/u2  +  w*2 


(7.11) 


With  the  same  expressions  for  the  gains  kv  and  kv  the  NGG  guidance  laws  in  3D  are: 


ay  =  —kySinOy 


(7.12) 


The  validity  of  this  extension  to  3D  has  been  tested  successfully  via  numerical  experi¬ 
ments,  the  results  of  which  are  presented  in  Chapter  (8). 
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Chapter  8 

Numerical  Experiments 


The  DGG,  NGG  and  LGG  algorithms  that  were  developed  in  the  previous  chapters  have 
been  tested  via  numerical  experiments  carried  out  in  MATLAB.  The  experiments  involved 
a  finite  space  with  two  obstacles  in  various  positions,  and  each  of  the  algorithms  were  used 
to  find  the  path.  The  experiments  were  first  carried  out  for  the  two  dimensional  case,  and 
then  extended  to  three  dimensions  using  the  methodology  described  in  chapter  (7).  In  both 
these  cases,  the  performance  of  the  algorithm  was  tested  in  the  presence  of  an  autopilot  lag. 
We  present  the  results  of  the  experiments  in  this  chapter. 

8.1  DGG,  LGG  and  NGG  in  two  dimensions 

In  this  section  we  present  the  simulation  results  for  the  algorithms  developed  in  chapters  4 
and  5.  As  elaborated  in  chapter  6,  the  gains  have  been  chosen  such  that  the  results  of  the 
DGG,  LGG  and  NGG  guidance  algorithms  give  the  same  results. 

8.1.1  Case  I:  No  obstacles  critical 

The  plots  in  Figure  (8.1)  and  (8.2)  show  the  path  found  and  the  control  effort  when  neither 
of  the  two  obstacles  is  found  to  be  critical,  and  the  UAV  may  go  directly  to  the  destination. 

The  dashed  lines  indicate  the  safety  boundary  of  the  obstacles.  The  algorithm  finds  that 
the  obstacles  are  not  critical  and  hence  the  UAV  is  guided  to  the  destination,  such  that  the 
control  effort  is  high  in  the  beginning.  The  path  thus  quickly  settles  along  the  aiming  line. 
The  control  plot  indicates  a  higher  turning  at  the  start  and  settles  to  zero  quickly.  The  value 
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Path  found  by  Dl,  LAP  and  NAP  guidance  when  no  obstacle  is  critical  Control  plots  for  Dl,  LAP  and  NAP  guidance  when  no  obstacle  is  critical 


Figure  8.1:  Path  found  by  DGG,  LGG  and  NGG  Figure  8.2:  Control  plots  for  DGG,  LGG  and 
when  no  obstacle  is  critical  NGG  when  no  obstacle  is  critical 


of  the  factor  a  that  decides  the  rate  of  settling  is  fixed  at  0.6.  It  is  clear  that  the  correlation 
established  in  chapter  6  is  valid,  since  the  plots  in  all  three  cases  show  the  same  results. 


8.1.2  Case  II:  One  obstacle  critical 

Next,  we  look  at  the  case  when  only  one  of  the  two  obstacles  is  found  to  be  critical.  The 
plots  (8.5)  and  (8.6)  show  the  path  and  control  plots  in  such  a  condition. 


Control  plots  for  Dl,  LAP  and  NAP  guidance  when  1  obstacle  is  critical 


Figure  8.3:  Path  found  by  DGG,  LGG  and  NGG  Figure  8.4:  Control  plots  for  DGG,  LGG  and 
when  one  obstacle  is  critical  NGG  when  one  obstacle  is  critical 


50 


The  second  obstacle  is  critical  and  the  algorithms  avoid  it  by  aligning  towards  the  tangent 
of  its  safety  boundary.  The  control  plot  shows  that  at  first  the  algorithms  were  aiming  at  the 
destination,  and  settled  quickly  along  the  line  (by  4  seconds).  However  at  8.2  seconds,  the 
aiming  point  was  changed  to  the  destination,  and  a  peak  in  control  is  found  at  this  point, 
which  causes  quick  alignment  along  the  destination. 

8.1.3  Case  III:  Two  obstacles  critical 

When  both  the  obstacles  are  found  to  be  critical,  the  plots  are  as  shown  in  Figures  (8.5)  and 

(8,6). 


Path  found  by  LAP,  Dl  and  NAP  guidance 


Figure  8.5:  Path  found  by  DGG,  LGG  and  NGG 
when  both  obstacles  are  critical 


Control  plots  for  LAP,  Dl  and  NAP  guidance 


Figure  8.6:  Control  plots  for  DGG,  LGG  and 
NGG  when  both  obstacles  are  critical 


The  plot  in  Figure  (8.5)  shows  that  the  safety  boundaries  of  both  the  obstacles  are 
successfully  avoided  by  the  algorithms.  The  control  plot  shows  three  peaks  -  one  for  each 
time  the  aiming  point  changes.  At  first  the  first  obstacle  is  critical  so  a  control  is  generated 
that  effects  an  alignment  that  avoids  the  first  obstacle.  This  alignment  occurs  by  1  second. 
At  1.7  seconds,  the  second  obstacle  is  found  to  be  critical,  hence  a  peak  control  effort  is 
generated  that  aligns  the  trajectory  along  the  tangent  to  the  safety  boundary  of  the  second 
obstacle,  thereby  avoiding  the  second  obstacle.  The  final  peak  achieves  alignment  with  the 
destination.  It  may  be  noticed  that  there  is  a  slight  discrepancy  in  the  third  peak  in  the 
control  plot  for  the  LGG  algorithm.  This  occurs  because  of  the  approximations  mentioned 
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in  chapter  6.  The  NGG  is  thus  exactly  analogous  to  the  DGG  guidance  algorithm,  whereas 
the  LGG  guidance  law  is  an  approximation  of  the  DGG  algorithm. 

8.2  Testing  the  DGG,  LGG  and  NGG  algorithms  in 
2D  for  performance  in  the  presence  of  autopilot 
lags 

Every  UAV  has  an  autopilot  lag  which  includes  the  lag  in  several  components  of  the  UAV. 
In  order  to  test  the  performance  of  the  DGG,  LGG  and  NGG  algorithms  in  the  presence  of 
autopilot  lags,  we  modeled  the  autopilot  lag  as  a  first  order  response  system  as  follows: 


Where  a*  represents  the  commanded  value  of  control,  i.e.  the  control  calculated  by  the 
DGG,  LGG  and  NGG  algorithms.  ay  represents  the  output  of  the  autopilot  lag  system,  and 
r  is  the  autopilot  lag.  In  order  to  incorporate  the  lag  into  the  system,  we  augmented  the 
autopilot  output  ay  into  the  state  equations  (3.1). 

8.2.1  Case  I:  Autopilot  lag:  0.1  seconds 

We  tested  the  DGG  guidance  algorithm  in  presence  of  an  autopilot  lag  of  0.1  second.  The 
resulting  path  and  control  plots  are  shown  in  Figures  (8.7)  and  (8.8). 

The  plot  in  Figure  (8.7)  indicates  that  for  an  autopilot  lag  of  0.1  second,  the  path  found  is 
not  very  different  from  a  path  found  without  any  autopilot  delay.  The  control  plot  indicates 
that  an  autopilot  lag  changes  the  control  plot  significantly.  This  is  because  the  autopilot  has 
been  incorporated  into  a  closed  loop  system,  and  the  DGG  algorithm  attempts  to  achieve 
an  alignment  before  the  settling  time.  This  leads  to  oscillations  in  the  control. 

8.2.2  Case  II:  Autopilot  lag:  0.2  seconds 

The  autopilot  lag  is  now  increased  to  0.2  seconds.  The  resulting  plots  are  shown  in  Figures 
8.9  and  8.10. 
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Path  found  by  Dl  guidance  with  and  without  autopilot 


Control  plot  for  Dl  with  and  without  autopilot 


Figure  8.7:  Path  found  by  DGG  with  and  with-  Figure  8.8:  Control  plot  for  DGG  with  and  with¬ 
out  autopilot  lag;  lag=0.1  seconds  out  autopilot  lag;  lag=0.1  seconds 


The  deviation  from  the  original  path  is  thus  not  significant,  although  the  control  plot 
shows  oscillations,  which  are  discussed  in  Case  I  above. 


8.2.3  Higher  autopilot  lags 

When  autopilot  lags  greater  than  0.2  seconds  are  incorporated,  there  occur  significant  devi¬ 
ations  from  the  original  path.  With  the  same  obstacle  positions  as  in  Case  II,  if  an  autopilot 
lag  of  0.3  seconds  is  incorporated,  the  control  plot  is  as  shown  in  Figure  8.12.  This  plot 
shows  the  performance  of  the  DGG  and  LGG  guidance  laws. 

Figure  8.12  shows  that  both  the  DGG  and  the  LGG  guidance  laws  show  significant 
deviations  from  the  original  control  effort.  However  the  deviation  is  extremely  high  in  the 
case  of  LGG,  with  the  result  that  the  control  demanded  by  the  LGG  algorithm  reaches 
unrealistic  values.  Thus  it  is  clear  that  the  DGG  guidance  law  is  preferable  in  the  presence 
of  autopilot  lags.  Figure  shows  the  path  found  by  LGG  and  the  DGG  guidance  in  presence 
of  the  autopilot  lag  of  0.3  seconds. 

The  Figures  8.13  and  8.14  show  the  path  found  and  the  control  plots  for  the  DGG  and 
LGG  guidance  in  the  presence  of  an  autopilot  lag  of  0.4  seconds. 

The  control  plots  8.14  show  that  both  the  DGG  and  the  LGG  guidance  laws  lead  to 
oscillations  in  the  control.  However  the  highest  control  demand  in  DGG  guidance  is  only 
38  m/s2,  whereas  the  highest  control  demand  in  the  LGG  guidance  is  an  infeasible  value  of 


53 


Path  found  by  Dl  with  and  without  autopilot 


Control  plot  for  Dl  guidance  with  and  without  autopilot 


Figure  8.9:  Path  found  by  DGG  with  and  with¬ 
out  autopilot  lag;  lag=0.2  seconds 


Figure  8.10:  Control  plot  for  DGG  with  and 
without  autopilot  lag;  lag=0.2  seconds 


-151.3  m/s2.  Additionally  the  paths  shown  in  Figure  8.13  shows  that  the  path  found  by  the 
LGG  guidance  law  violates  the  safety  boundary  of  the  second  obstacle.  This  is  a  significant 
disadvantage. 


Path  found  by  Dl  and  LAP  guidance  with  autopilot  Control  for  Dl  and  LAP  guidance  with  autopilot  lag 


Figure  8.11:  Path  found  by  DGG  with  and  with-  Figure  8.12:  Control  plot  for  DGG  with  and 
out  autopilot  lag;  lag=0.3  seconds  without  autopilot  lag;  lag=0.3  seconds 
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Path  found  by  Dl  and  LAP  in  presence  of  high  autopilot  lag 


Control  for  Dl  and  LAP  guidance  in  presence  of  high  autopilot  lag 


time 


Figure  8.13:  Path  found  by  DGG  with  and  with-  Figure  8.14:  Control  plot  for  DGG  with  and 
out  autopilot  lag;  lag=0.4  seconds  without  autopilot  lag;  lag=0.4  seconds 


8.3  DGG,  LGG  and  NGG  in  three  dimensions 

In  this  section  we  present  the  simulation  results  which  validate  the  extension  to  three  di¬ 
mensions  formulated  in  Chapter  7.  Figure  8.15  shows  the  path  found  by  DGG,  LGG  and 
NGG  in  three  dimensions  when  both  the  obstacles  are  critical.  The  safety  boundaries  of  the 
obstacles  are  spheres  in  the  3D  case. 
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displacement  along  Z 


Figure  8.15:  Path  found  by  DGG,  LGG  and  NGG  in  three  dimensions 
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The  XY  and  XZ  views  of  this  path  is  shown  in  Figures  8.16  and  8.17. 


- Linear  APG 

- Dl  Guidance 

- Nonlinear  APG 


XY  view  of  Path  found  by  LAP,  Dl  and  NAP 


Initial  point:(2,3,0) 
Obstaclel  :(20,5  -5) 
Obstacle2:(46,10,5) 
Destination:  (60,10,2) 


-  1  Linear  APG 
1  Dl  Guidance 
- Nonlinear  APG 


XZ  view  of  Path  found  by  LAP,  Dl  and  NAP 


Initial  point:(2,3,0) 
Obstaclel  :(20,5,-5) 
Obstacle2:(46,10,5) 
Destination:  (60,10,2) 


Figure  8.16:  XY  view  of  the  path  found  by  DGG,  Figure  8.17:  XZ  view  of  the  path  found  by  DGG, 
LGG  and  NGG  in  three  dimensions  LGG  and  NGG  in  three  dimensions 


The  plot  of  the  controls,  i.e.  the  acceleration  in  the  y-direction  ay  and  the  acceleration 
in  the  z-direction  az  are  shown  in  Figures  8.18  and  8.19.  Each  peak  in  the  control  represents 
each  change  in  the  aiming  point. 

Control  in  y  for  Dl,  LAP  and  NAP  Control  in  z  for  Dl,  LAP  and  NAP 


Figure  8.18:  Control  for  DGG,  LGG  and  NGG  Figure  8.19:  Control  for  DGG,  LGG  and  NGG 
in  Y-direction  for  3D  case  in  Z-direction  for  3D  case 


The  simulation  results  presented  in  this  Chapter  show  that  the  DGG,  LGG  and  NGG 
offer  a  novel  and  satisfactory  solution  to  the  problem  of  online  collision  avoidance. 
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Chapter  9 

Conclusions  and  Future  Work 


In  this  study,  a  new  Dynamic  Inversion  based  Differential  Geometric  Guidance  law  and 
consequently  the  Linear  Geometric  Guidance  and  Nonlinear  Geometric  Guidance  laws  are 
proposed,  and  a  correlation  formulated  between  them.  These  guidance  laws  have  been  used 
to  solve  the  online  collision  avoidance  problem  in  a  unique  way.  The  path  found  by  these 
laws  settle  along  the  desired  line  quickly,  instead  of  maneuvering  until  the  final  time.  These 
algorithms  are  developed  in  two  dimensions,  and  extended  successfully  to  three  dimensions. 

Current  work  includes: 

1.  developing  an  algorithm  for  avoiding  collision  with  moving  obstacles  (both  benign  and 
maneuvering 

2.  exploring  the  use  of  these  guidance  laws  in  avoiding  collision  between  LTAVs  within  a 
team 

3.  incorporating  a  more  realistic  point-mass  model  of  the  UAV 

The  scope  of  the  three  guidance  laws  DGG,  LGG  and  NGG  developed  in  this  study  are 
however  not  limited  to  collision  avoidance.  Since  alignment  occurs  quickly,  the  guidance  laws 
hold  promise  for  target  interception  problems  as  well  (such  as  ballistic  missiles). 

This  study  has  thus  been  successful  in  developing  algorithms  that  are  successful  in  solving 
the  online  obstacle  avoidance  problem  satisfactorily. 
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